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(57) Abstract: The present invention discloses a position determination device (50) for 
an autonomous apparatus (1). The position determination device (50) comprises means 
(54) for dividing up driving of the autonomous apparatus (1), based on rotation veloc- 
ities of the driving wheels (17, 18), into different driving modes (40a-40u), in which 
the actual track width (30) of the apparatus (1) is substantially constant The device 
(50) further comprises calibration means for calculating the actual track width (30) for 
each one of the driving modes (40a-40u). The calibration means performs a calculation 
method, in which the apparatus (1) is aligned in an initial direction and turns in one 
of the driving modes (40a-40u). The actual total turning angle of the apparatus (1) is 
measured together with the wheel rotations of the driving wheels (17, 18). Calculation 
of the actual track width (30) is perfonned on the basis of this actual total turning angle 
and the wheel rotations. 
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METHOD AND DEVICE FOR DETERMINING POSITION OF AN AUTONOMOUS 

APPARATUS 

TECHNICAL FIELD 

5 The present invention generally relates to autonomous apparatuses, and in particular to 
devices and methods for inq>roving position detramination thereof. 

BACKGROUND 

10 Autonomous apparatuses such as autonomous or robotic vacuum cleaners and other 
self moving devices are well known in the prior art, for example as disclosed in the 
International Patent Applications WO 97/41451 (US Patent No. 5,935,179) and WO 
00/38028, respectively. Such autonomous surface treatment apparatuses generally 
have a main body, being supported on or by a number of motor-driven wheels or 

15 rollers and means for surface treatment such as rotatmg brushes in combination with 
a vacuum cleaning device. Further, a sensing system, usually in combination with 
transmitters, is provided for guidance, navigation and obstacle detection. The sensing 
system generally sweeps around, the horizon in analogy, for example, with a ship 
radar. A microprocessor together with appropriate software controls the transmitters 

20 and motors of the device. Normally, the microprocessor also receives ii^ut data 
from the wheels and the sensing system for the purpose of position information and 
localization of wall limitations dj& well as potential obstacles. This input data is then 
typically used as die basis for navigatmg the autonomous apparatus so that it, for 
mstance, will be able to perform a cleaning function or other surface treatment 

25 function accordmg to some predetermined strategy and at the same time avoid 
colliding with different obstacles, which may be arranged in the field of operation, 
besides avoiding collisions with limitations such as walls or the like. 



Typically, an autonomous apparatus orients itself at any time witiiin its permitted 
30 motion area defined by a map on the basis of information obtained from the sensing 
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system. Furthermore, the map is typically generated and updated by the autonomous 
apparatus itself during its movements. It is often vital for the apparatus to obtain an 
as accurate map as possible, as well as an exact positioning and orientation within 
the area defined by the map, to be able to perform its operations. Several systems for 
position determination of autonomous apparatuses have therefore been developed, 
based on different techniques of prior art. Apparatus contained internal systems such 
as distance sensors in connection to wheels, have proven to be most cost effective. 

The internal position determination systems usually are composed of wheel sensois 
registering the rotational motion of the wheels. In order to determine how far tibe 
apparatus has travelled since previous registration, the information from die wheel 
rotations is used together with the wheel diameter. This can be done with a 
reasonable good accuracy when the surface is not too soft, since the effective wheel 
diameter then can be assumed to be constant. When the sur&ce is slippery or soft, 
tiie apparatus may sddd and/or the wheels may spin. The calculated travelled distance 
based on the wheel rotations is dien incorrect compared to the actual distance 
travelled by the apparatus. In order to correct for this ^ppage, a positicm calibration 
method has to be performed. Such a method is disclosed in the US Patent 5,794,166. 
The method includes prediction of a cumulative overall slippage of die apparatus 
occurring when the apparatus travels from a starting pomt to a d^tination pomt 
along an imaginary path. This imaginary path includes a rotation of the apparatus at 
the starting point by a first rotation angle so that the apparatus is directed towards the 
destination point. The apparatus then travels forwards from the staring point to the 
destination point. Finally, a rotation of th& apparatus at the destination point is 
performed that aligns the apparatus with the requred rotational position of Ms pomt 
Furdiermore, an overall slqipage per wheel based on at least one distemce dependent 
prescribed slij^age is calculated. To determine this, die distance between the 
effective contact pouits betwe^ die two driving wheels and the surface onto which 
die apparatus is to operate, defined as the "track widdi" of the autonomous 
apparatus, must be known. The track widdi is fiuthermore utilized for calculating die 
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rotational angle of the autonomous apparatus, as flie apparatus moves along tlie 
imaginaiy path. 

A problem with the method disclosed in US Patent 5,794,166 is that the actual track 
width of the autonomous apparatus varies depeodiag on the surface, as well as on the 
type and dhection of the turn. The reason for this is both that the effective contact pomt 
varies and that the wheel suspension is not totally rigid. As the effecthre contact point is 
displaced during turning of the apparatus, the actual track width will change, and the 
slippage calculation method in US Patent 5,794,166 will M and an erroneous rotation 
of the apparatus is performed. 

SUMMARY 

An object of the present invention is to provide an accurate position determmaticm 
method ibr autonomous apparatases and devices therefore. Another iiirther object of 
the present invention is to inqnove the position determination using a calihratioa 
method for calculating an actual trade width of the apparatuses and devices dierefore. 

The above objects are achieved by devices and methods according to the enclosed 
claims. In general words, an autonomcxis apparatus is equqiped with a posidon 
detemnnation device for p(»ition determination and localization durii^ its opoation. 
Ihe position device conqnises encoders for generatmg signals corresponding to wheel 
rotations of the driving wheels. The position change and the heading of die ^>paratus 
smce die previous recording are obtained from th^ y/bse\ rotations, in combination 
with the diameter of the wheels and the track width of the qiparatus. The motion of die 
autonomous apparatus is in the pr^ent mvention divided up into different drivmg 
modes, each one associated widi a sq)arate actual track width. Each driving mode is 
preferably defined m such a way diat die trade width of the apparatus is substantially 
constant widi diat driving mode. 
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The position detennmation device further comprises calibration means for calculating 
the actual track width associated with each one of the driving mode used by the 
autonomous apparatus. The calibration means in turn comprises means for aligning the 
£^aratus in an initiai direction decided by the operator, or an internal or external 
S source. The apparatus is then caused to turn in die driving mode, whose actual trade 
widdi is to be calculated. As the apparatus is turning, a means determines the total 
turning angle of die apparatus, based on an ext^nal reference or some mtemal device. 
Encoders register die corresponding wheel rotations during the turning. Preferably, 
from the wheel rotation and a temporary track width, an expected turning angle is 
10 calculated. A difference between the actual and the expected turning angles is thm 
determined, and the actual track width is calculated as a correction of the tenxporaiy 
trac^ widdi based on the angle difference. 

The major advantages of the present invention come as a result of the division of the 
15 operation of the autonomous apparatus into different driving modes, in which the actual 
track widdi is substantially constant. This gives a much more accurate and reliable 
position determination compared to methods according to the prior art, based on one 
track width. 

20 BRIEF DfiSCRIPIION OF THE DRAWINGS 

The invention, together widi further objects and advantages thereof, will be best 
understood by reference to the following description takm togedier widi die 
accompaiqrmg drawings, in which: 

25 

Fig. 1 illustrates a top view of an embodnnent showing a vacuum-cleaning robot 
equipped according to die present invention; 



Hg. 2 is a side view of the autonomous apparatus according to Fig. 1; 

30 
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Fig. 3 is a front view of tlie autonomous apparatus accoiding to Fig. 1 ; 



Fig. 4 illustrates a hardware block diagram of the embodiment of Fig. 1; 

. S Fig. 5a, 5b and Sc illustrate dijQferent possible ways of defining driving modes of an 
autonomous apparatus according to the present invention; 

Fig. 6a and 6b illustrate the principles of associating the contact points between the 
wheels and the surface and an actual track width; 

10 

Fig. 7 is a detailed view of the hardware block diagram of Fig. 4 illustrating the 
hardware and the software mainly used by the present invention; 

Fig. 8 illustrates a flow diagram of the position detraninadon mediod of the present 
15 inv^ition; and 

Fig. 9a and 9b are flow diagrams of the position calibration method of the present 
invention. 

20 DETAILED DESCRIPnON 

Throu^out dje drawings, die same reference characters will be used for corresponding 
or similar elem^its. 

25 In the followmg, the invention will be described with reference to a particolar exaiiq>le 
of an autonontous qiparatus, namely an autonomous vacuumrcleaning device. It 
should, however, be understood that die invention is not limited thereto, and diat the 
invention is applicable to various other autonomous apparatuses, such as transport 
vehicles in manufacturing environments, movable multi-purpose robots and robotic 
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lawmnowers, as well as autonomous surface treatment devices for sweeping, 
brushing and floor polishiiig. 

In the present disclosure, "speed" refers to the absolute value of "velocity", which 
5 has both a magnitude and a direction, i.e. can be either positive or negative. 

Goieral features 

Fig. 1 ilhistrates in a three-dimensional top view of an illustrative embodiment of an 
autonomous vacuum-cleaning device 1, which by itself wiU move on a floor and 

10 vacuum-clean a room. In the front portion there is arranged an ulliasonic Systran. Tbe 
ultrasonic system CQnq)rises a strip-shaped ultrasonic transmitter 10 having a length 
covering of the order 180" of the front perimeter of the device as illustrated in Figs. 2 
and 3. As seen in Fig. 2, the transmitter 10 with str5)-shaped elements is mounted 
above a lower first row of microphone units 12. Above the str^^shaped transmitter 

15 elements a second row of microphone units 13 is localized. The ultrasonic edio sensor 
microphones 12 and 13 together with the transmitter 10 form an ultrasonic sonar 
system for the navigation of the device. In the ilhistrative embodiment fihe transmiOer 
transducer is counlersmked in a forward directed, movable bumper unit 16. The 
bunq)er 16 controls a left and a right bumper touch sensor, eiflier one bang actuated if 

20 the bumper makes contact with an obstacle. In Figs. 2 and 3 it will be seen that the 
device has two diametrically positioned wheels 17, 18. Each wheel 17, 18 is 
independently driven by a sq>arate motor preferably equq)ped wifli a gearbox. The 
driven wheels 17 and 18 will enable die device to also rotate around its own symmetry 
center or around either wheel 17, 18. On die axis from eadi motor, driving the 
25 respective wheel 17 and 18, a respective quadrature sensor is mounted. Quadrature 
signals from the sensors are connected to a built-in micrppiocessor cfwitmllmg the 

device. The signals from these sensors, or equivalent devices will be used for obtaining 
a dead count for estimating flie distance of travel. This is described more in detail 
below. Optional wheels support the back of die device. The device is generally 
30 balanced witii a slightiy larger weight on the rear half of the device, carrying for 
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instance the batteries, such that it will always move wifli all wheels in contact witii the 
floor. Dae to this balancmg the device may easily climb the edges of floor carpets and 
thetlte. 

5 Further, the autonomous device may advantageously be equipped with Hall effect 
sensors, preferably one in front of each wheel, for detection of a magnetic fence and/or 
one or more magnetic strq)s in c(mection with the automatic charging station used for 
charging the device. The magnetic fence can be used to restrict the movement of the 
device. For exan^le, the fence can be placed so ^t device does not £all down flie 
10 staks. It can also be placed so as to separate rooms wilhout havmg to close the door, hi 
this way, it is possible clean one room at a time, which has turned out to be an effective 
way of cleamng. 

Fig. 4 is a hardware block diagram of the device according to Figs. 1, 2 and 3. The 
IS b2a[dmie basically consists of a processor board, which is configured to drive tibe 
ultrasonic transmitter and the corresponding microphone based receiver system, the fan 
and brush motors, the two wheel motors, as well as other components of the 
autonomous vacuum-cleanipg device. The processor board is essential^ built around a 
data processor such as the MC68332 from Motorola Inc. 

20 

The sonar localization sensing system formed by the transmitter and receiver system 
is utilized by tiie autonomous vacuum-cleaning device for obstacle detection 
purposes, such as detection of obstacles in the path of the moving device, pinpointing 
tiie exact location of die nearest obstacle. The processor controls tiie transmitter and 
25 receives ii^ut data from the receiver system for subsequent evaluation. 

The processor also controls the motor for the rotating brush as well as tiie motor for 
the fan, wherein the fan generates tiie necessary vacuum for the general function of 
the vacuum cleaner. Air from the fan motor is additionally in a known manner 



wo 02/075469 PCT/SE02/00420 

8 

Utilized for cooling purposes and the air is exhausted at a giUed outlet at the top of 
the device. 



The processor is controlled by software stored in a number of different types of digital 
5 memories for exanq)le of type FPROM, RAM or EEPROM, which are all well known 
to a person funiliar to conqmter techniques. Additionally the processor has its own 
clocking system CLK also known from the prior art. 

The system as illustrated in Fig. 4 further comprises a number of switches, two bumper 
10 switches and two tilt switdies. The two bumper switches L-Bunq>er, R-Bunq)er are 
connected to two TPU iqput pms working hi disoiete I/O mode, and are used as a 
complement to the sonar system for detection of collisions with obstacles. The tilt 
switches are used to detect whether the device is leveled witii the floor or tilted. 

t 

15 The Systran also includes a number of switches for inpat commands firom a control 
panel. For example, this enables die user to turn die vacuum cleaner on and off, and to 
select one of a number of cleaning programs. 

Signals iq[>resentathre of die magnetic fields that are sensed by the Hall sensors are fed 
20 to the processor via the A/D-converter and processed thereby to allow detection of the 
automatic diargmg station and the magnetic fence. The offset voltages of die analogue 
Hall sensors may vaiy with time, temperature and mdividual sensors, and dioefore a 
zero field refeiaice pomt is c(nistantly recalculated with a slow averagmg filter and 
adjusted based on pulse width modulated signals fixnn the processor. 

25 

In order to detect malfunctions, various signals are continuousfy measured and fed to 
the processor for evaluation, either directiy via the A/D-converter or first through the 
multiplexer MUX and tiirai via the A/D-converter. 
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The wheel motois for driving the apparatus are separately controlled by pulse-width 
modulated signals of 5 kHz generated by two more channels from the Time 
Processor Unit m the main processor. In order to detect how much each wheel has 
rotated, the quadrature encoders mounted in connection with the wheels generate 
5 quadrature signals that are connected to Time Processor Unit (TPU) inpats of the 
MC68332. The quadrature signals are processed by the processor to provide position 
information by keeping track of tiie distance of travel and preferably also the rotation 
of the autonomous device during movement, which will be described m more detail 
below. 

10 

Position determination 

In Fig. 6a, a position determination of the autonomous apparatus 1 according to the 
present invention is performed usmg signals from encoders SI, 52 located in 
connection to the driving wheels 17, 18. These encoders 51, 52 register the rotation 

15 of respective wheel 17, 18 and die signals are dien ou^utted to a mioroprocessor. 
The microprocessor calculate the position change of the apparatus 1 since previous 
registration by combimng the wheel rotation signals with mformation of the wheel 
diameters. In a firat embodiment of the present invention the encoders 51 , 52 are 
made of HaU sensors generating a quadrature signal in response to rotation of a 

20 magnetic disc 55 mounted in coimection with the wheels 17, 18. The magnetic discs 
55 are discs divided iq> into a immber of sectors with different magnetic directions. 
As the discs 55 rotate the encoders. 51, 52 register the change in magnfttiinn and can 
thereby measure the rotation of respective wheel 17, 18. Other embodiments are 
possible, such as slotted disc encoders and related devices. 

25 

The signals from the encodera 51, 52 are not only used for determinmg traveled 
distances but also for calculating the headmg of the apparatus 1 during its movement. 
Turning of die autonomous apparatus is givm by: 
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_ DistRight - DistLeft ^ 180 

TrackWidth n ^' 



where Aa is the turning angle in degrees of the apparatus 1 since previous position, 
DistRight and DistLeft is the distance traveled by the right and the left wheel, 
5 respectively, and TrackWidth is tiie actual track width 30 of the apparatus 1 . Thns, 
to determine the heading of tiie apparatus 1, in addition to the wheel rotation signals, 
the actual track width 30 is needed. The problem is that the track width 30 of the 
autonomous apparatus 1 varies depending on (he surface, as well as on the type and 
direction of the turn. The motion of the apparatus 1 is therefore in the present 

10 invention separated into different driving modes, in which the track width 30 is 
substantially constant or only varies between acceptable limits. Figs. Sa, 5b and 5c 
illustrate how such driving modes 40a-40u are defined by the rotation velocities of 
the driving wheels 17, 18. Li respective Fig., a coordinate system, in which the x- 
axis represents rotation velocity of the left wheel and rotation velocity of the right 

15 wheel is represented by the y-axis, is illustrated. Which wheel is defined as tihe left 
wheel or the right wheel does not matter as long as the definition is used consistendy 
throughout the entire procedure, i.e. there is no risk for mix-up between die two 
wheels. 



20 In tiie CTibodimait of die present invention illustrated in Fig. 5a, the drivmg modes 
• 40a-401 are defined by a respective range of ratios between the rotation velocities: 



VelUftWheel ^ ' 



25 where VelRightWheel and VelLeftWheel are the velocities of the two driving wheels 
17, 18, respectively, and A and B are the Ihnits, widun which the quotient associated 
with the driving mode 40a-401 is to be defined. This way of defining driving modes 
divides the coordinate system into sectors, such as 40a in Fig. 5a. The quotient will 
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be the same if Hie magnitudes of the velocities of the two wheels are the same but the 
directions are different. If the ratio is the single defining parameter, driving forwards 
with both wheels and driving backwards with the same rotation speed of respective 
wheel are also defined, in this embodiment, as the same driving mode. In Fig. Sa, 
5 sectors 40a and 40b are e.g. then associated witib the same driving mode. However, 
additional defining parameters, such as the sign of one of the velocities, may also be 
used. The sectors 40a and 40b may then constitute separate driving modes. 

Fig. 5b illustrates another embodiment for defining driving modes 40m-40|p of die 
10 present invention. The drivmg modes 40m-40p are defined in that the rotation 

velocity of one or both wheels is within a predetermined velocity range. The rotation 
velocities are, thus, limited by an upper rotation velocity limit and/or a lower 
rotation velocity limit. This can be applied for each wheel independently, 40m or 
4Qn, or simultaneously for both wheels 40o. Li die latter case a more precise division 
15 of driving modes is obtained. For some operations it may, however, be sufficient to 
base the driving mode definition on the rotation velocity of only one wheel. The 
driving mode 40p illustrates the use of indefinite velocity range. 

The driving modes iUustrated in Fig. 5b should only be interpreted as examples of 
20 possible driving modes. In a preferred embodunent, die drivmg modes should be 
complementary and togedier cover all allowed motion pattrans. 

Fig. 5c illustrates yet another embodiment for defining the drivmg modes 40q-40u of 
the present invention, wliich today is considered as die most preferred embodim^. 

25 This definition divides die drivmg operation of the qjparatus 1 into five driving 
modes, of which tibree 4Qr, 40t, 40u correspond to distinct velocity ratios and two 
40q, 40s correspond to ranges of rotation velocity ratios. 40r is the driving mode 
used for forward travel, where die rotation velocities of the two driving wheels 17, 
18 are die same. Here, any associated actual track widdi may be used, since the 

30 apparatus, at least ideally, does not turn. A conqiensation for imintentional turns 
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may, however, optionally be present. 40t and 40u illustrate driving modes turning 
die apparatus around its own axis on the spot in a respective direction. The 
magnitudes of the rotation velocities of the wheels are the same but die directions of 
rotation are opposite, in 40u the right wheel is rotating forwards whereas the left 
5 wheel is rotating backwards. The opposite is true for 40t, where the left rotates 
forwards and the right wheel rotates backwards. In order to turn while driving 
forwards, the two driving modes 40q and 40s are needed. 40q represents a mode 
involving turning the apparatus to die left and 40s represents a mode turning the 
apparatus to the right. In the former driving mode, 40q, the right wheel is rotatmg 

10 forwards either alone or in combination with forward rotation of the left wheel. The 
rotation speed of the left wheel has, though, to be lower than the rotation speed of 
the right wheel. The same is true for 40s except that it is the left wheel that rotates 
alone or faster than the right wheel, hi diis definition of driving modes, the apparatus 
is never allowed to move baclcwards. It instead turns on the spot and then moves 

IS forwards. Its movement is, tinis, limited to die five different driving modes, which 
are sufticient to cover the allowed motions used during operation of the autonomous 
q^aratus 1 . A backward motion may, however, be used at special occasions, e.g. 
when the apparatus encounters an obstacle or a magn^ fence. If such motion is 
used, it is tiien preferably straight, whereby th^e is no track width dependence. 

20 

The motion of the autonomous apparatus 1 is, as mentioned above, generally divided 
up mto different driving modes 40a- 40u, in which the track width 30 may be 
considered as substantially constant. Fi^. 6a and 6b i]lmninate tiie need for this 
division. 

25 

Referring to Fig. 6a, this is a view of principle of the lower part of an autonomous 
apparatus 1 showing the effective contact points 31, 32 between the drivmg wheels 
17, 18 and a surface 33, when the apparatus is driving, forwards witii die same 
rotation speed on both driving wheels. The effective contact points 31, 32 of 
30 respective wheel are typically, in this driving mode, located in the center of the parts 
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of the lateral areas of the wheels 17, 18 that are in contact with the surface 33, as 
illustrated in Fig. 6a. These effective contact points 31, 32 delBne the actual track 
widtii 30 of tiie ai^aiatos. 

5 In Fig. 6b, the actual track width 30 in a different driving mode is shown. In this 
drivmg mode the apparatus is tummg right while drivmg. The effective contact point 
32 of the driving wheel in the direction of flie turn, i.e. the right wheel 18, is 
displaced from the center of the lateral area as m Fig. 6a towards the side facing the 
turning direction. This displacement of contact points changes the actual track widtih 
10 30 of the apparatus, resulting in a noticeably different track width compared to the 
drivmg mode associated with Fig. 6a. 

Figs. 6a and 6b should merely be viewed as illustrative examples showing the 
dependence of the track width 30 upon the driving mode of the apparatus 1 . The 
IS actual track width 30 and the effective contact pomts 31, 32 will change further at 
other driving modes but the spkit of the driving mode concept should be clear from 
the Figs 6a and 6b. 

Fig. 7 illustrates a part of the hardware block diagram of Fig. 4 in more detail, 
20 omitting die parts not directly used for position detemunation purposes. In order to 
move the autonomous apparatus 1, pulse- width modulated signals (JPWM) are 
ou^utted from the Time Processor Unit in the microprocessor 21 . These FWM 
signals control the applied voltage to respective driving motor and thereby control 
the rotadon speed and direction of respective wheel. As mentioned above, encoders 
25 51 , S2 register the wheel positions, generating quadrature signals that are forwarded 
to the microprocessor 21, and ccnresponding velocities are determined. In order to 
detramine the position change of the apparatus 1 since previous recorduig the actual 
track width 30 and die driving mode 40 of the apparatus 1 have to be determined. In 
the digital memories 20, software used for position determination, is stored. Based 
30 on die wheel positions, encoded in the quadrature signals, determination means 54 in 
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the digital memories 20 determines the present driving mode 40 of the q)paratas 1 
by use of wheel rotation velocities. From this driving mode 40 the associated actual 
track width 30 is obtained, which is used in the subsequent position calculations. 

S Before the actual position calculations it has to be determined which track width to 
use. The driving mode and therefore also the definition of driving modes have to be 
known. It might be, from operational point of view, most suitably to have several 
different definitions of driving modes, such as some of the definitions of Figs. 5a, 5b 
and 5c. The operator can then switch between definitions of differ^t sets of driving 
10 mod^ vfhem i.e. the surface changes or when the autonomous apparatus is to 

perform a new operation where the former driving mode definition is not perfecfly 
representative. Whichever driving mode definition used, the actual track width has to 
be determined and associated to each drivmg mode. This is in the present invendon 
preferably performed by a calibration mediod, which is described further below. 

15 

Once die actual track widdi is known, the position change is calculated by calculation 
means 53 stored in the digital memories 20, which are loaded and executed in the 
microprocessor 21. The travelled distimce is calculated usmg die wheel rotations and 
the diameter of respective wheel, whereas the heading is given by equation (1). By 

20 starting m an initial well defined position and calculating the position change at some 
intervals as the apparatus moves, and storing this information in the digital 
memories, the apparatus may keq> track of its movement during its operation and 
dius of its present location. This information is used by e.g. surface treatment 
autonomous apparatuses together with a map over the area of operation, to know 

25 which parts of the operation area that have been treated and which parts that are 
untreated. 

In order to determine the actual track widdi 30 of respective driving mode 40a-40u, a 
position calibration means of the present invention is preferably used. Firstly 
30 aligning means 22 aligns the autonomous appaiatus 1 in an initial direction. The 
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aligning means 22 controls the driving means 60 via the PWM signals from the 
microprocessor 21 so that the apparatus 1 turns and possibly also moves to ikce a 
direction selected by the aligning means 22. The aligning means 22 could preferably 
conq)rise magnetic detectors 23 « 24, e.g. Hall sensors, detecting a magnetic field that 

5 is provided to direct the apparatus 1 in the correct direction. The magn^c field may 
originate firom magnetic strq>es or other magnetic sources, such as the magnetic 
fence and/or one or more of the magnetic strips in connection with the automatic 
charging station mentioned above. Other embodiments are also possible; the aligning 
means 22 may comprise push buttons tbsA the operator pushes when the apparatus 1 

10 is to calculate the track width 30. The initial direction may then be die direction die 
apparatus is facing when the button is pushed so no turning before the actual 
calibration is necessary. Alternatively, an external signal fi*om some source may 
trigger the calibration method and the aligning means 22 then comprises a recdver, 
sensithre to the external signal. 

15 

Once the apparatus 1 has been aligned in die initial direction, the microprocessor 21 
sends PWM signals to the driving means 60. The driving means 60, in tum, causes 
the apparatus 1 to tum in the driving mode 40a-40u associated with the actual track 
width 30 to be determined. U die apparatus moves according to the driving mode 4Qr 

20 in Fig. 5c, it is actually movmg straight ahead, i.e. not turning. In this driving mode 
40r, the actual track width 30 is in l^t arbitrary, e.g. given by the distance between 
the wheels and no calibration is necessary. On the other hand, for other possible 
drivuig modes an actual calculation is necessary to obtain the correct track width. 
The actual total turning angle of the apparatus, during the turning in die selected 

25 driving mode, is then determined by reference means 80. The reference means 80 
uses some internal or external reference for obteining die actual turning angle. 
G3rros, sensitive to changes in travelling direction, could be used as an internal 
reference for calculating the total turning angle of the s^paratus 1. Bxtemal 
references could be a magnetic field sensed by die magnetic detectors 23, 24 in die 

30 aligning means 22 or odier magnetic detectors. Just as for the initial aligmng other 
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external signals, such as a signal beacon or another source somewhere in the area of 
operation, may be used as a stationary reference. Doing the turning in the selected 
drivmg mode, the angle relative the reference changes and the reference means 80 
can thereby calculate the total turning angle of the apparatus. The apparatus may 
S preferably turn a predetermmed total turning angle, which e.g. could be determined 
by the operator. The wheel rotations correspondmg to this turning, predetermined or 
not, are simultaneously registered by the encoders 51, 52. By using the wheel 
rotations and the total turning angle, the actual track width 30 of the driving mode 
40a- 40u can be calculated by means of a calculation means 70. From the wheel 

10 rotations, an expected total turning angle of the apparatus is preferably calculated in 
. an expectation means 71 , based on a temporary track widdi. This temporary track 
width may be the track width used during driving straight forward, 40r m Fig. 5c, 
the nominal track width or a previously calculated track width. Difference means 72 
calculate a possible difference between the actual total turning angle, determined by 

IS die reference means 80, and the txpected turning angle, obtained from die 

e?q)ectation means 71. Based on this difference, a correction of the temporary track 
widdi is determined by correction means 73. The temporary track width is, dius, 
calibrated to correspond to tte actual track widdi 30 of the apparatus 1 . 

20 It is also possible to calibrate the apparatus by rotating the wheels a predetermined 
number of rotations and simply registering the corresponding actual turning angle. 
Similar calculations as above are used to obtain die correct actual turning angle of 
the apparatus. 

25 The track widths may, using the method above, be calculated for all possible driving 
modes at one instance, e.g. at the start of die operation. The information of die 
driving modes and assodated track widths may then be stored in the digital 
memories 20 of the autonomous apparatus 1 . As the driving mode changes during 
the operation, the respective stored actual track width is used for position 

30 determination. This stored data can be used for longer-term operations so that 
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calculations are only performed if a new, until now not used, driving mode is 
encountered, and not every time the apparatus is started. Another possibility is to 
calculate the track width as the apparatus changes driving mode. In this way the 
calibration method has to be performed at least once for every new driving. The 
5 information may be stored in the memories 20 for later uses. However, preferably 
the calibration is performed regularly or when there are indications of changes in 
motion conditions. 

Fig. 8 illustrates a «;hematic flow diagram of the position determination method of 
10 the present invention. The method starts in step 100. In step 101, a wheel rotation is 
determined for the two driving wheels. A driving mode is then ia step 102 
determined, based on the wheel rotations. In step 103, the position change since 
previous calculation is calculated, based on an actual track width, associated with tiie 
driving mode. Finally, the position detennination method is conipleted in step 104. 

15 

The calibration method of the present invention is briefly described in Figs. 9a and 
9b. The calibration procedure starts in step 200. In step 201, the apparatus is aligned 
in the initial direction, decided by the operator or some exterml or internal iiq>ut. 
The apparatus is then in step 202 caused to turn, in the driving mode associated with 
20 tiie actual track width to be calculated. The actual turning angle is determined in step 
203, nsing an external reference or an internal means. In step 204, tiie corresponding 
wheel rotations are registered preferably by encoders in connection wiUi respective 
wheel. The actual track width of tiie present driving mode is calculated in step 205, 
before the method is completed in step 209. 

25 

Fig. 9b describes a preferred maimer to accomplish the calculation step 205 in more 
detail. In step 206, an ejected total turning angle is calculated based on the wheel 
rotations and a temporary track width. The calculation continues in step 207, where 
a difference between die actual and the expected total turning angles is detramined. 
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In step 208, the actual track width is calculated as a correction of the temporary 
track width using the difference in step 207. Finally the method is ended in step 209. 

It will be understood by a person skilled in the art that various modifications and 
5 changes may be made to the present invention without departure firom the scope 
diereof, which is defined by the app^ided ckmis. 
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CLAIMS 

1. A position determination method for an autonomous apparatus (1), conq)risii]g 
the steps of: 

S determining a wheel rotation of a first (17) and a second (18) wheel, 
respectively; and 

calculating a position change based on said first and second wheel rotations and 
a track width (30), characterized by the further step of: 

determimrig a driving mode (40a-40u) based on said wheel rotations, whereby 
10 said calculating step is based on an actual track width (30) associated with said 
driving mode (4ba-40u). 

2. The method according to claim 1, characterized in that said driving mode 
(40a-40u) is defined by means of rotation velocities of said first (17) and said second 

15 (18) wheels. 

3. The method accordmg to claim 2, characterized in that said driving mode 
(40a-401, 40q, 40s) is defined by a range of ratios between said rotation velocities. 

20 4. The method according to claim 2, characterized in tliat said driving mode 
(40mr40p) is defined in that said rotation velocity of said first wheel (17) is within a 
predetermined first velocity range. 

5. The method according to claims 2 or 4, charactoized in tliat said driving 
25 mode (40m-40p) is defined in that said rotation velocity of said second wheel (18) is 

within a predeteimined second velocity range. 

6. The method according to claim 2, diaracterized by five driving modes (40q- 
40u) defined by: 



wo 02/075469 PCT/SE02/00420 

20 

forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 
S backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 

forward rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower tiian die rotation speed of said first wheel (17); and 
10 forward rotation of said second wheel (18) either alone or in combination with 
forward movement of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower tiian die rotation speed of said second wheel (18). 

7. A calibration method for a positioning device (50) of an autonomous apparatus 
IS (1), characterized by the steps of: 

aligning said autonomous apparatus (1) in an initial direction; 
turning said autonomous ^aratus (1) in a first of a number of driving modes 
(40a-40a); 

determining an actual total turning angle of said autonomous s^aratus (1); 
20 measuring a wheel rotation of a first (17) and a second (18) wheel, 
respectively; and 

calculating an actual track width (30) associated widi said first driving mode 
(40a-40u) based on said measured wheel rotations and said determined actual total 
taming angle. 

25 

8. The method according to claun 7, characterized in that said calculating step in 
turn comprises the stops of: 

calculating an expected total turning angle of said autonomous apparatus (1) 
based on said measured wheel rotations and a tenqiorary track width; 
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calculating a difference between said expected and said actual turning angles of 
said autonomous apparatus (1); and 

determining said actual track width (30) as a correction of said temporary track 
width based on said difference. 

5 

9. The method according to claims 7 or 8, characterized in that said drivii^ 
modes (40a-40u) are defined by means of rotation velocities of said first (17) aid 
said second (18) wheels. 

10 10. The method according to claim 9, charactoized in that said driving modes 
(40a-401, 40q, 40s) are defined by a range of ratios betwe^ said rotation velocities . 

11. The method according to claim 9, characterized hi that at least one of said 
driving modes (4Qm-40p) is defined m that said rotation velocity of said first w^ied 

15 (17) is within a predetermined first velocity range. 

12. The metiliod accordmg to claims 9 or 11, charactorilzed hi that at least one of 
said driving modes (40m-4(^) is defined in that said rotation velocity of said secord 
wheel (18) is within a predetermined second velocity range. 

20 

13. The method according to claim 9, characterized hy five drivmg modes (40q- 
40u) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 
25 forward rotation of said fiist wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 

backward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; . 
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fprwaid rotation of said first wheel (17) either alone or in combination with 
forward movement of said second wheel (18), where the rotation speed of said 
s^nd wheel (18) is lower than the rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or in combination witti 
5 forward movem^t of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower tiian the rotation speed of said second wheel (18). 

14. The method according to any of the clauns 7 to 13, characterized in that said 
actual turning angle determining st^ in tarn comprises the step of: 

10 utilizing an operator iapat or an external inpat. 

15. The method according to claim 14, characterized in that said external iapat is 
a signal generated by detection of a magnetic field. 

15 16. A position determining device (50) of an autonomous apparatus (1) comprising: 
means (51, 52) for determining a wheel rotation of a first (17) and a second 
(18) wheel, respectively; and 

calculation means (53) for calculating a position change based od. said first and 
second wheel rotations and a track widtii (30), said calculation means being 
20 connected to said means (51, 52) for measunng said wheel rotations, characterized 
by 

means (54) for determining a driving mode (40a-40u) based on said wheel 
rotations connected io said calculation means (53), whereby said calculation means 
53 is arranged to base said calculation on an actual track width (30) associated with 
25 said drivmg mode (40). 

17. The device accordmg to claim 16, dharactoized hi that said driving mode 
(40a-40u) is defined by means of rotation velocities of said first (17) and said second 
(18) wheels. 
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18. The device accoiding to claim 17, characterized in that said driving mode 
(40a-401, 40q, 40s) is defined by a range of ratios between said rotation velocities. 

19. The device accoiding to claim 17, characterized in that said driving nuxte 
S (40m-40p) is defined in that said rotation velocity of said first wheel (17) is within a 

predetermined first velocity range. 

20. The device according to claims 17 or 19, characterized in that said driving 
mode (40m-40p) is defined in that said rotation velocity of said second wheel (18) is 

10 within a predetemnned second velocity range. 

21. The device according to claim 17, characterized by five driving modes (40^- 
40u) defined by: 

forward rotation of said first wheel (17) and forward rotation of said second 
15 wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 

backward ro^tion of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation speed; 
20 forward rotation of said first wheel (17) eidier alone or in combioation with 
forward movement of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than the rotation speed of said first wheel (17); and 

forward rotation of said second wheel (18) either alone or m combination with 
forward movem^ of said first wheel (17), where fiie rotation speed of said first 
25 wheel (17) is lower than the rotation speed of said second wheel (18). 

22. The device according to any of the clahns 16 to 21, characterized by position 
calibration means in turn conq)rising: 

means (22) for aligning said autonomous apparatus (1) in an mitial direction; 
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means (21) for causing driving means (60) to turn said autonomous apparatus 
(1) in a first of a number of driving modes (40a-40u); 

means (80) for determining an actual total turning angle of said autonomous 
apparatus (1); 

S first calculation means (70) for calculating said actual track width (30) 

associated with said first driving mode (40a-40u) based on said measured wheel 
rotations and said determined actual total turning angle. 

23. The means accordmg to claim 22, characterized in that said first calculation 
10 means (70) m turn comprises: 

second calculation means (71) for calculating an expected total turning angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 
tenq)orary track width; 

durd calculation means (72) for calculating a difference b^een said e^tpected 
IS and said actual turning angles of said autonomous apparatus (1); and 

means (73) for determining said actual track width (30) as a correction of said 
tenq>orary track width based on said difference. 

24. A position calibration means of an autonomous apparatus, characterized by 
20 means (22) for alignmg said autonomous apparatus (1) m an initial direction; 

means (21) for causing driving means (60) to turn said autonomous ^paratus 
(1) m a first of a nmnber of driving modes (40a-40u); 

means (80) for determining an actual turning angle of said autonomous 
apparatus (1); 

25 means (SI, 52) for measuring a wheel rotation of a first wheel (17) and a 
second wheel (18), respectively; and 

first calculation means (70) for calculating an actual track width (30) associated 
widi said first driving mode (40a-40u) based on said measured wheel rotations and 
said determined actual total turning angle, said first calculation means (10) being 
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connected to said means (80) for detennining said actual turning angle and said 
means (SI, 52) for measuring said wheel rotations. 

25. The means according to clann 24, characterized in that said first calculation 
means (70) in turn comprises: 

second calculation means (71) for calculating an expected total turning angle of 
said autonomous apparatus (1) based on said measured wheel rotations and a 
temporary track width; 

third calculation means (72) for calculating a difference between said expected 
and said actual turning angles of said autonomous apparatus (1); and 

means (73) for determining said actual track width (30) as a correction of said 
temporary track width based on said difference. 

26. The means according to claims 24 or 25, characterized in fliat drivmg modes 
(40a-40u) are defined by means of rotation velocities of said first (17) and said 
second (18) wheels. 

27. The means according to claim 26, characterized in that said drivmg modes 
(40a-401, 40q, 40s) are defined hy a range of ratios between said rotation vdodties. 

28. The means according to claim 26, characterized in that at least one of said of 
driving modes (4Qm-4a|p) is defined in tiiat said rotation velocity of said first wheel 
(17) is within a predetermined first velocity range. 

29. The means according to claims 26 or 28, characterized in that at least one of 
said of driving modes (40m-4Pp) is defined in that said rotation velocity of said 
second wheel (18) is witiiin a predetermined second velocity range. 

30. The means according to claim 26, characterized by five driving modes (40q- 
40u) defined by: 
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forward rotation of said first wheel (17) and forward rotation of said second 
wheel (18) with equal rotation velocities; 

forward rotation of said first wheel (17) and backward rotation of said second 
wheel (18) with equal rotation speed; 
S backward rotation of said first wheel (17) and forward rotation of said second 

wheel (18) with equal rotation speed; 

forward rotation of said first wheel (17) eiflier alone or in combination widi 
forward moveinent of said second wheel (18), where the rotation speed of said 
second wheel (18) is lower than die rotation speed of said first whsel (17); and 
10 forward rotation of said second wheel (18) either alone or in combination with 

forward movement of said first wheel (17), where the rotation speed of said first 
wheel (17) is lower than the rotation speed of said second wheel (18). 

31. The means according to any of the claims 24 to 30, characterized in fliat said 
15 means (22) determining said actual total turning angle of said autonomous apparatus 
in turn conq>rises operator iiqmt or external input means. 



32. The means according to clahn 31, characterized in that said external input 
means is a magnetic field detector. 

33. The means according to claim 32, characterized in that said magnetic field 
detector is a Hall sensor (23, 24). 
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